Init_State.c

Go to the documentation of this file.

#include "derivative.h"
#include "Compile_Options.h"
#include "Init_State.h"
#include "SM.h"
#include "SBC_AL.h"
#include "Central_Accel_AL.h"
#include "HAL.h"
#include "Application_Globals.h"
#include "MailScheduler.h"
#ifdef USE_LABVIEW
#include "Labview.h"
#endif
/*
 ******************************************************************************
 * Constants
 ******************************************************************************
 */
static const uint16_t cu16SMInitValidInputStates = SM_STATE_SETUP;
#ifdef USE_LABVIEW
static const uint8_t cau8SuccessGUIMsg01[] = "Initialization successful.";
#endif
/*
 ******************************************************************************
 * Globals
 ******************************************************************************
 */
/*
 ******************************************************************************
 * u32fnSMInit
 ******************************************************************************
 */
uint32_t u32fnSMInit(void)
{
  uint32_t u32Status;
  
  /* Verify that we can execute - Previous state ended correctly */
  u32Status
      = u32fnSMValidateCurrentState((uint16_t*)&cu16SMInitValidInputStates, 1u);
  if(CLEAR == u32Status)
  {
    /* Here comes the real contents of the state */
    LOCK_STATE_EXECUTION();
    
    (void)u8fnSBCPreSchedulerEnableWarningLamp(TRUE);
    
    vfnSMInitAppGlobals();
    
    /* Pre-scheduler config for SBC, Central Accel.  */
    vfnSBCPreSchedulerInit();
    vfnCAPreSchedulerInit();
    
    if(CLEAR == u8fnInitPostalService(TRUE))
    {
      if(CLEAR == u8fnLaunchScheduler(TRUE))
      {
        /* Run initial tests, finalize configuration for Central   */
        /* Accelerometer These go first because our CA needs       */
        /* some time after configuration and before requesting     */
        /* measurements                                            */
        if(CLEAR == u32fnCAInit())
        {
          /* Add small delay to 1) separate SPI transfers and   */
          /* 2) allow extra time for the CA to take it's config */
          DELAY_MSEC(1u);
        
          /* Same as above for SBC */
          u32Status = u32fnSBCInit();
          
          /* Give some time for sync pulses to line up */
          DELAY_MSEC(1u);
        }
        else
        {
          /* Central accelerometer is not happy */
          u32Status = INIT_STATE_CA_ERROR;
        }
      }
      else
      {
        /* Flag it as an error */
        u32Status = INIT_STATE_MCU_ERROR;
      }
    }
    else
    {
      /* Flag it as an error */
      u32Status = INIT_STATE_MCU_ERROR;
    }
    
    SCHED_WHAT_IS_THE_TIME(gu32SMCycleStartTime);
    /* Unlock the state */
    UNLOCK_STATE_EXECUTION();
  }
  else
  {
    /* Leave */
  }

  /* Set the next state */
  if(CLEAR == u32Status)
  {
    vfnSMWriteNextState(SM_APPLICATION_START);
#ifdef USE_LABVIEW
    vfnDisplayGUISuccessMessage();
#endif
  }
  else
  {
    vfnSMWriteNextState(SM_STATE_ERROR);
  }
  return (u32Status);
}
#ifdef USE_LABVIEW
/*
 ******************************************************************************
 * vfnDisplayGUISuccessMessage
 ******************************************************************************
 */
static void vfnDisplayGUISuccessMessage(void)
{
  vfnLVEnable(TRUE);
  (void)u8fnLVWaitForTxPort();
  (void)u8fnLabViewSendMSorMP((uint8_t*)&cau8SuccessGUIMsg01, sizeof(cau8SuccessGUIMsg01),
                              LV_SEND_SERIALLY, LV_MP_MSG);
  vfnLVEnable(CLEAR);
  return;
}
#endif
/*
 ******************************************************************************
 *
 *  End of file.
 *
 ******************************************************************************
 */